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(54) Rolxyl system and machining method with robot system 

(57) A robot system and a machining method capa- 
ble of accurately and simply cutting an end of a pipe into 
a saddle shape and forming a hole on an outer surface 
thereof, and further machining a workpiece of a three- 
dimensional shape which does not have platelike 
shape. A tool unit is attached to a final axis of a movable 
arm of a robot. The tool unit is provided with a first addi- 
tional variable axis expanding and retracting vertically 
and a second additional variable axis expanding and 
retracting in the horizontal direction. By rotating the final 
axis, a cutting tool (machining nozzle of laser) at a distal 
end of the tool unit is turned about the final axis to cut a 
workpiece W of a pipe shape By driving the first and the 
second additional variable axes in synchronism with 
rotation of the final axis, the cutting into a saddle shape 
and the forming of a hole are carried out. The movable 
arm of the robot is only for rotating the final axis and 
therefore machining accuracy is promoted. 
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Description 

1. Field of the Invention 

[0001 ] The present invention relates to a robot system 
for machining a workpiece by a tool unit attached to a 
distal end of a robot movable arm, and a method of 
machining with such robot. In particular, the invention 
relates to a robot system suitable for cutting an end of a 
pipe in a saddle shape and for forming a hole on a side 
face of the pipe, and a method of machining using the 
robot system. 

2. Description of the Related Art 

[0002] In recent years, there have been many cases 
in which pipes are used for parts of a suspension of an 
automobile. With increase of using pipes for parts of the 
automobile suspension, there has been an increase in 
machining operation for cutting an end face of a pipe W 
in a saddle shape and machining operation for forming 
a hole on a side face of a pipe part, as shown in FIG. 1 1 . 
In the machining operation of cutting in a saddle shape 
and forming a hole on a side face of a pipe, a machining 
tool needs to operate accurately in a three-dimensional 
space and even when the machining operation is car- 
ried out by a robot, a path control function higher than 
that of an ordinary level is required. 
[0003] When carrying out the machining operation by 
a robot on a workpiece which does not have platelike 
shape, such as a cylindrical workpiece. a workpiece 
having an elliptic section or a prism or a pyramid, in the 
conventional art. a cutting tool is attached at a distal end 
of a movable arm of a robot at a predetermined angle 
and the machining is can^ied out by totally operating a 
plurality of yes of the robot movable arms as shown in 
FIG. 13. In the case shown in FIG. 1 3. a cutting tool 2 of 
laser nozzle attached to the distal end of a movable arm 
100 of the robot is brought to face the workpiece W of a 
pipe shape and a plurality of the movable arms of the 
robot are driven to tum the distal end of the movable 
arm 100 as shown by an arrow Q with respect to the 
workpiece W. thereby cutting the workpiece W or form- 
ing a hole on the workpiece W. As described, since the 
machining operation is carried out by totally operating 
the plurality of axes of the robot movable arm. accuracy 
of a machined face is lowered by vibration of the robot. 
[0004] Further, in machining a workpiece of a pipe 
shape using a conventional robot, a cut face SI of the 
pipe shaped workpiece W is made perpendicular to cir- 
cumferential surface of the workpiece W as shown in 
FIG. 12a. and the machining to form a slant cut face S2 
at an angle relative to the circumferential surface as 
shown In FIG. 12b can not be performed. When pipes 
are wekled to join them as shown in FIG. 1 1 . it is difficult 
to carry out a firm welding if the cut face SI is perpen- 
dicular to a circumferential surface of a pipe as shown In 
FIG. 12a. and the machining of cutting a pipe in a sad- 



dle shape performed by the conventional robot is not 
suitable for tiie welding for forming a joint. 
[0005] It is an object of the invention to provide a robot 
system capable of one or more of the following actions, 

5 namely accurately and simply cutting an end face of a 
pipe in a saddle shape, forming a hole on a side face of 
a pipe, and further machining a surface of a workpiece 
having a three-dimensional shape. 
[0006] A robot system of one embodiment of the 

10 present invention comprises: a movable arm including a 
plurality of links connected by joints and controlled by a 
robot controller having a software processing function; 
and a tool unit mounted on a distal end of the movable 
arm. and having an effecting end biased with respect to 

IS a final rotational axis of the movable arm and directed to 
tiie final rotational axis. Further, the tool unit may be 
provided with a variable axis for linearly moving tiie 
effecting end and/or rotating tiie effecting end thereof. 
[0007] When machining a workpiece of a pipe shape 

20 using a robot, embodying tiiis invention tiie final rota- 
tional axis of the robot movable arm is brought to coin- 
cide with a central axis of the pipe-shaped workpiece 
and tiie final axis of tiie robot movable arm is rotated to 
machine tiie workpiece by the tool unit. 

25 

BRIEF DESCRIPTION OF THE DRAWINGS 
[0008] 

30 FIG. 1 is a block diagram of essential portions of an 
embodiment of a robot controller according to tiie 
inventk>n; 

FIG. 2 is a schematic view of a tool unit according 
to a first embodiment of the invention, 

35 FIG. 3 is a schematic view of a tool unit according 
to a second embodiment of the invention. 
FIGS. 4a and 4b are schematic views showing a 
cutting operation of a pipe having an elliptic section 
and a square section according to the second 

40 embodiment of the invention, 

FIG. 5 is a schematic view showing an inclined cut- 
ting according to the second embodiment of tiie 
invention; 

FIGS. 6a and 6b are schematic views of jointing of 
45 a pipe and a workpiece which is cut by the inclined 
cutting; 

FIG. 7 is a schematic view of a tool unit according 

to a third embodiment of the invention; 

FIG. 8 is a schematic view of a tool unit according 

50 to a fburtii embodiment of tiie invention; 

FIG. 9 is a schematic view of a tool unit according 
to a fifth embodimerrt of the invention; 
FIG. 10is a schematic view of a tool unit according 
to a sixth embodiment of the invention; 

55 FIG. 11 Is a schematic view showing jointing of 
pipes; 

FIGS. 12a and 12b are schematic views showing a 
relationship between a cut face of a pipe-shaped 
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workpiece and a pipe in jointing; 
FIG. 1 3 is a schematic view showing a conventional 
machining method in which a pipe-shaped work- 
piece is cut by a robot; 

FIG. 14 Is a flowchart of teaching operation s 
processing lor machining according to the inven- 
tion; 

FIG. 15 is a flowchart of machining operation 
processing according to the invention; 
FIG. 16 is a schematic view for obtaining a calcula- io 
tion equation for calculating a path of a distal end of 
a tool unit in a saddle shape machining; and 
FIG. 17 is an additional schematic view for obtain- 
ing the calculation equation for calculating a path of 
a distal end of a tool unit in a saddle shape machin- is 
ing. 

[0009] Hereinafter, a description will be made on an 
example of a laser machining robot system for cutting a 
workpiece or making a hole on a workpiece by laser 20 
using a laser nozzle as a cutting tool provkjed at a distal 
end of a tool unit, according to an embodiment of the 
invention. 

[0010] FIG. 1 is a block diagram showing essential 
part of a hardware architecture of a robot controller for 25 
carrying out the invention and the architecture is the 
same as that of conventional robot controller. A bus 1 07 
is connected with a main CPU 101. a memory 102 
including RAM, ROM and a nonvolatile memory (EEP- 
ROM). an interface 103 for a teaching operation panel, 30 
an irput/output interface 106 for external device and a 
servo control unit 105. 

[0011] A teaching operation panel 104 connected to 
the interfece 1 03 is an ordinary one with display function 
by LCD and an operator can perform teaching, modify- 3$ 
ing and registjering of an operation program for the robot 
and setting of various parameters, as well as command 
a playback operation of a taught operation program and 
a jog feed through manual operation of the teaching 
operation panel 104. Further, the display is used for 40 
information to an operator, display of inputted data and 
simulation result. 

[0012] A system program for supporting basic func- 
tions of the robot and the robot controller is stored in 
ROM of the memory 102. Further, the operation pro- 45 
gram off the robot whk^h is taught in accordance with an 
application, and related set data are stored in the non- 
volatile memory of the memory 102. Further, RAM of 
the memory 102 is used for temporarily storage of data 
in various catoulation processings which are carried out so 
by the CPU 101. 

[0013] The servo control unit 105 comprises servo 
controllers #1 -#n (n: the sum of the number of total axes 
of the robot and the number of variable axes in a tool 
unit), receives a motion command produced by calcula- 55 
tion processing for controlling the robot (path planning, 
interpolation and inverse transformation basedi thereon) 
and controls servo motors as actuators for respective 
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axis mechanisms of the robot through respective servo 
amplifiers. 

[0014] Further, external input/output circuits of the 
input/output interface 106 are connected to sensors 
provkJed at the robot and actuators and sensors at 
peripheral devices, particularly to a laser oscillator 108 
in relation with the invention. A tool unit having a laser 
nozzle is attached to a distal end of a movable arm of 
the robot and laser beam emitted from the laser oscilla- 
tor 108 is irradiated from a machining nozzle to a work- 
piece thereby cutting the workpiece. 
[0015] The constitution of the above-described robot 
controller is not different from that of a conventional 
robot controller, but the robot system according to the 
invention differs from the conventional one in that the 
tool unit is attached to the distal end of the movable arm 
of the robot and when the tool unit has a movable ele- 
ment, the movable element of the tool unit is also con- 
trolled as an additional axis by the servo control unit 105 
in the robot controller. 

[001 6] FIG. 2 is a schematic view of essential portions 
according to a first embodiment of the invention. 
[001 7] A robot wrist 1 a is provided at a distal end of a 
robot movable arm 100 and a tool unit 10 is attached to 
the robot wrist la so that a rotational center axis of the 
robot wrist as a final axis 1 of the movable arm 100, 
coincides with a rotational center of the tool unit 1 0. The 
tool unit 10 comprises an attachment portion I0a for 
attaching the tool unit 10 to the robot wrist la. a link 10b 
in a shape of "L" extending perpendicuiarly to the final 
rotational axis 1 of the movable arm 100 from the 
attaching portion 10a and bent to extend parallel to the 
final rotational axis 1. and a machining nozzle 2 
attached at a distal end of the link 10b so that a laser 
irradiating direction is perpendicular to the firmi rota- 
tional BMs 1 of the movable arm 100. 
[001 8] In performing a cutting operation at an end face 
of the workpiece W of a pipe shape by the robot having 
the tool unit 10, the robot is positbned so that the final 
axis 1 of the robot movable arm 100 (the rotational 
center axis of the robot wrist la) coincides with a central 
axis of the pipe-shaped workpiece W and the machining 
nozzle 3 is located at a cutting position on the workpiece 
W. Then, a laser beam is irradiated from the machining 
nozzle 2 to the workpiece W. while rotating the final axis 
1 of the robot movable arm 1 00 to thereby cut the work- 
piece W. 

[001 9] In this cutting operation of the workpiece W of 
a pipe shape, only the final axis 1 of the movable arm 
100 is driven to rotate during the operation, and thus the 
machining accuracy is made high and the machining 
operation can be carried out simply. 
[0020] The cutting position in the axial direction of the 
workpiece W (left and right direction in FIG. 2) can be 
selected to some degree by moving the position of the 
robot wrist la in the left and the right direction in FIG. 2. 
However, there is limited a diameter of the workpiece W 
which can be cut only by rotating the final axis 1 of the 
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robot movable arm by using the tool unit 10. With 
respect to a pipe having a radius larger than a distance 
between the rotational center axis of the tool unit 10 (the 
final rotational axis of the robot movable arm) and the 
distal end of the machining nozzle 2, that is, larger than 5 
a shifting or biasing amount of the machining nozzle, 
the workpiece cannot be cut by only rotating the final 
axis 1 of the robot movable arm. In this case, the 
machining operation must be carried out by totally driv- 
ing a pluraility of axes of the robot. 10 
[0021 ] Further, with respect of workpieces off a square 
prism shaped pipe constituted by a combination of 
planes and an elliptic shaped pipe which are not of 
cylindrical shape, or with respect to saddle shape cut- 
ting of a cylindrical pipe, such workpiece cannot be cut is 
with the robot having the tool unit 1 0 by only rotating the 
final axis 1 of the robot movable arm. In such a machin- 
ing operation, a plurality of variable axes of a robot have 
to be driven. 

[0022] In view of tiie above, a description will be made 20 
on a second embodiment having a tool unit capable of 
machining workpieces having various shapes and 
capable of cutting in a saddle shape and forming a hole 
on a surtece of a workpiece of a pipe shape by providing 
one or more additional variable axis to the tool unit, 25 
referring to FIG. 3. 

[0023] A tool unit 1 1 schematically shown in FIG. 3 
comprises an attaching portion 11a for attaching the 
tool unit to the robot wrist 1a witii a final rotational €Dds 

1 at a distal end of the robot movable arm, a first addi- so 
tional variable axis 11b for performing extending and 
retracting motions from the attaching portion 11a per- 
pendicularly to tiie final rotatk>nal axis 1 of the movable 
arm, a second additional variable axis 11c connected 
perpendicularly to a distal end of the first additional var- 35 
iable axis lib for performing extending and retracting 
motions in the direction of the final rotatk>nal axis 1 of 
the movable anti of tiie robot, and the machining nozzle 

2 attached to a distal end of the second additional vari- 
able axis 1 1 c so that a laser irradiation direction is per- 40 
pendicular to the final rotational axis 1 of the robot 
movable arm. 

[0024] Each of the above-described first and second 
additional variable axes is constituted by a rotational 
motion/linear motion converting mechanism for convert- 45 
ing a rotational motion of a motor into a linear motion 
such as a linear mechanism using a motor and a ball 
screw or using a lever member. Further, an air cylinder 
or a linear guide driven by a servo motor can be used. 
[0025] Motors for driving the first and the second addi- so 
tional variable axes lib and 1 1 c mentioned above are 
respectively controlled by a servo control by servo con- 
trollers for conf oiling additional axes in tiie servo con- 
trol unit 105 of the robot controller 
[0026] According to ttie second embodiment, with the ss 
provision of tiie first additional variable axis I1b^ the 
workpieces W having various diameters can be cut. 
That is, by driving tiie first additional variable axis, a dis- 



tance (bias or shift distance) between the distal end of 
the machining nozzle 2 and the final rotational axis 1 of 
the robot movable arm which is the rotational center 
axis of the tool unit 1 1 , may be adjusted in conformity 
with the radius of the workpiece W of a pipe shape to be 
cut. In the cutting operation, similar to the above- 
described first embodiment, the robot is positioned so 
that the central axis of the workpiece W coincides with 
the center of the robot wrist (the final rotational axis 1 of 
the robot movable arm and the rotational center axis of 
tiie tool unit 11). and an effecting end of the machining 
nozzle is positioned to a cutting position (in left and right 
direction of FIG. 3) of the workpiece W by driving tfie 
second additional variable axis 11c. Then, a laser beam 
is irradiated from the machining nozzle 2 to the work- 
piece W to cut tiie workpiece W while rotating the final 
axis 1 of tiie robot movable arm. 
[0027] Further, by performing rotation of the final axis 
1 of the robot movable arm and driving of the second 
variable axis 1 1 c are earned out in synchronism, cutting 
of saddle shape designated by a broken line in FIG. 3 or 
forming a hole on the surface of the workpiece W can be 
carried out. That is, a saddle shape cutting can be car- 
ried out by reciprocating tiie second additional variable 
axis 1 1c twice at a predetermined stroke in synchronism 
with rotation of tiie final axis 1 of the movable arm dur- 
ing one rotation of the final axis. Further, a hole can be 
formed on a surface of the workpiece W of a pipe shape 
by reciprocating the second additional variable axis 1 1 c 
at a predetermined stroke during a period in which the 
final axis 1 is rotated in one direction by a predeter- 
mined angle, and subsequentiy reciprocating the sec- 
ond additional variable axis 1 1c in a reverse direction at 
the predetermined stroke during a period in which tiie 
final axis 1 is rotated in a reverse direction by the prede- 
termined angle. 

[0028] Further, by synchronizing the rotation of tiie 
final rotational axis 1 with the movement of the first addi* 
tional variable axis, cutting operation can be carried out 
on a pipe-shaped workpiece W having an elliptic section 
or a pipe-shaped workpiece W having a square section 
as shown in FIGS. 4a and 4b. 

[0029] That is, by provkJing the first additional variable 
axis 11b at the tool unit 1 1 . the robot can carry out cut- 
ting operation of a workpiece W of a shape of cylindrical 
pipes having different diameters or cutting operation of 
a pipe having an elliptic section or a square section. 
Further, by providing the second additional variable axis 
1 1c at tiie tool unit 1 1 , tiie robot can carry out forming a 
hole on a surface of a pipe and cutting a saddle shape 
at an end face of a pipe by driving tiie additional variable 
axis 1 1 c of the tool unit 1 1 only by rotating the final axis 
1 of the robot movable arm. Further, by providing tiie 
first and tiie second additional variable axes lib and 
1 1c at the tool unit 1 1 , the robot can cut a workpiece W 
of a shape of cylindrical pipes having different diame- 
ters, cutting a saddle shape, cutting a pipe having an 
elliptic or a square section and forming a hole on a sur- 
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face of a pipe only by rotating the final axis 1 of the mov- 
able ami of the robot. 

[0030] With the robot having the tool unit 1 1 according 
to the second embodiment, as shown In FIG. 5. by rotat- 
ing the final axis 1 of the robotmovable arm (rotational 
axis of the tool unit 1 1) and drivingly controlling the first 
and the second additional variable axes 11b and 1 1c in 
synchronism with the rotation of the final axis 1 of the 
robot movable arm while holding the final axis 1 and the 
central axis of a workpiece W of a pipe shape at a pre- 
determined angle therebetween, the workpiece W of a 
pipe shape is cut to have an end portion inclined suita- 
ble for connecting with another pipe R as shown in an 
elevation view of FIG. 6a and a respective view of FIG. 
8b. That is. when the workpiece W is to be connected to 
the pipe P. as shown in FIGS. 6a and 6b. machining as 
shown in FIG. 5 is carried out to cut the end portion of 
the workpiece W. 

[0031 ] FIG. 7 is a view showing essential portions of 
a third embodiment according to the invention. The third 
embodiment is used in machining a plurality of small 
pipes or in the case where a portion of a unitized part is 
cut. 

[0032] A tool unit 12 according to the third embodi- 
ment is constituted by an attaching portion 12a for 
attaching the tool unit 12 to the robot wrist la, a axis 
12b in an L shape extended from the attaching portion 
12a in parallel with an attaching lace of the robot wrist 
1 1 a (perpendicular to the final axis 1 of the movable arm 
of the rot>ot) and bent perpendicularly at a distal end 
thereof, an additional rotational axis 12c provided at a 
distal end of the axis 12b, a first additkDnal variable axis 
12d connected to the additional rotational axis 12c for 
expanding and retracting in a direction in parallel with 
the attaching face of the rok>ot wrist la. a second varia- 
ble axis 12e connected to a distal end of the first varia- 
ble axis 12d for expanding and retracting in a direction 
perpendicular to the first additional axis 12d and the 
machining nozzle 2 attached to a distal end of the sec- 
ond additional variable axis 12e in which, a directbn of 
irradiating laser beam is directed in a direction perpen- 
dicular to the additional rotational axis 12c (the final axis 
1 of the movat>le arm of the robot). 
[0033] When an end portion of a workpiece W of a 
small pipe is cut, the rcbtii is positioned such that a cen- 
tral axis of the workpiece W to be cut and tiie rotational 
center axis of the additional rotational axis 12c are 
brought to coincide with each other and an end face of 
the workpiece W to be cut and an end face of the addi- 
tional rotational axis 12c are opposed to each other. 
Further, the machining nozzle 2 is positioned at a posi- 
tion for cutting the workpiece W by driving the first and 
the second additional variable axes 12d and 12e. there- 
after, the additional rotational axis 12c is rotated while 
in^adiating laser beam from the machining nozzle 2 by 
which the end face of the workpiece W is cut. 
[0034] Further, when cutting a saddle shape or form- 
ing a hole on a peripheral face of the workpiece W, the 



second additional variable axis 12e may be driven in 
synchronism with rotation of the additional rotational 
axis 12c as has been explained in the second embodi- 
ment. Further, when the workpiece W of a small pipe 
5 has an elliptic section or a square section, cutting oper- 
ation is carried out by synchronizing the rotation of tiie 
additional rotational axis 12c and the driving of the addi- 
tional variable axis 12d similar to the second embodi- 
ment. 

10 [0035] According to the third embodiment, when the 
workpiece W is cut, the variable axis of the robot is not 
driven and tiie robot per se stays in a stationary state 
and hokis predetermined position and posture. The 
machining accuracy is improved since the variable axis 

15 of the robot is not driven, 

[0036] According to the above-described embodi- 
ments other than in the case of carrying out the macNn- 
ing mettiod shown in FIG. 5. the direction of irradiating 
laser beam of the machining nozzle 2 is in a direction 

20 perpendicular to the peripheral face of the workpiece W 
and the cut face is perpendicular to tiie peripheral face 
of the workpiece W. Thus, only a section perpendicular 
to tiie central axis off the pipe-shaped workpiece W is 
obtained. When a pipe is cut in a saddle shape and a 

25 cut face cut in the saddle shape is brought into contact 
with tiie peripheral face of otiier pipe, as shown in FIG. 
11 . for carrying out welding of tiie saddle shape, the cut 
face perpendicular to the peripheral face of the pipe pro- 
vides a joint state as shown in FIG. 12a to make the 

30 welding operation difficult and weMing of high strength 
is not obtained. However, if the cut face having an art>i- 
trary angle relative to tiie surface of the pipe can be 
obtained, as shown in FIG. 12b. the cut face and tiie 
peripheral face of the other pipe are t>rought Into dose 

35 contact with each other and welding at the joint position 
becomes facilitated and solid. 

[0037] Hence, a description wilt be given on a fourth 
embodiment in which a cut face having an arbitrary 
angle relative to a peripheral face off a pipe is obtained, 

40 referring to FIG. 8. 

[0038] A tool unit 13 comprises an attaching portion 
13a for attaching the tool unit 13 to the robot wrist 1a. a 
axis 13b extended from the attaching portion 13a per- 
pendiculariy to the final axis 1 of the movable arm of the 

45 robot and an additional rotary or pivoting axis 13c for 
angulariy moving a first additional variable axis 13d rel- 
ative to tiie axis 1 3b and the first additional variable axis 
13d is constituted by a structure capable of lineariy 
moving its distal end via a mechanism for converting 

so rotational movement of a motor or a ball screw to a lin- 
ear movement. 

[0039] Further, tiie tool unit 13 is provided witii a sec- 
ond additional variable axis 13e connected perpendicu- 
larly to a distal end of tiie first additional variable axis 
55 13d for linearly moving a distal end thereof by a mecha- 
nism of converting rotational movement to linear move- 
ment similar to the first additional variatsle axis 13d and 
the machining nozzle 2 attached to a distal end of the 
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second additional variable axis 13e. 
[0040] When operation of cutting a saddle shape is 
carried out on a workpiece W of a pipe shape, the robot 
is positioned such that the central axis of the workpiece 
W of a pipe shape and the final rotational axis 1 of the s 
movable arm of the robot are brought to coincide with 
each other and the robot wrist 1 a and an end face of the 
workpiece W are opposed to each other, the rotational 
axis 13c is positioned at a rotational angle to provide an 
angle of a cut face in starting cutting operation, further. io 
the machining nozzle 2 is positioned at a cut start posi- 
tion by driving the first and the second variable axes 1 3d 
and 13e. Further, in accordance with a taught program, 
while rotating the final axis 1 of the movable arm of the 
robot, in synchronism with the rotation, the rotational 
axis 13c and the first and the second additional variable 
axes 13d and 13e are controlled to drive by which there 
is carried out cutting operation providing the workpiece 
W with an aibitrary cut shape such as that in saddle 
shape cutting or forming a hole. Further, also the fourth 
embodiment can cut a workpiece which is not consti- 
tuted by a single plane such as a pipe having a section 
in a cylindrical shape, a pipe having a section in an ellip- 
tic prism shape, or a pipe having a section in a square 
p)rism shape. 

[0041] Although the at)Ove-described fourth emtKXli- 
ment is restricted by a size (diameter) of the workpiece 
W to be machined, FIG. 9 shows a fifth embodiment 
alleviating the restriction. According to a tool unit 14 
used in the fifth emkxxjiment, the axis 13b according to 
the fourth enixxJiment is changed to a variable axis. 
The fifth embodiment is provided with an attaching por- 
tion 14a for attaching the tool unit 14 to the robot wrist 
1a, a first additional variable axis 1 4b extended from the 
attaching portion 14a perpendicularly to the final axis 1 
of the movable arm of the robot where a distal end 
thereof is lineariy moved, a rotary or pivoting axis 14c 
for angulariy moving a second additional variable axis 
14d relative to the first additional variable axis 14b and 
further provided with a third additional variable axis 14e 
connected perpendicularly to a distal end of the second 
additional variable axis 14d for lineariy moving its distal 
end and the machining nozzle 2 attached to a distal end 
of the third additional variable axis 14e. Each of the 
above-described first, second and third additional varia- 
ble axes 14b, 14d and 14e is constituted by a structure 
in which its distal end can linearly be moved by a mech- 
anism of converting rotational movement of a motor or a 
ball screw into linear movement. 
[0042] A difference between the fifth embodiment and 
the fourth embodiment resides in whether or not the 
axis 14b (13b) extending from the attaching portion 14a 
(13a) perpendiculariy to the final axis 1 of the movable 
arm is lineariy moved, as mentioned akx>ve. As is appar- 
ent by comparing FIG. 8 with FIG. 9, In view of a change 
in the diameter of the workpiece, in view of inclination of 
the cut face, and also in view of a degree of freedom of 
a distance from the end face of the workpiece to the cut 



position, the fifth embodiment where one variable axis is 
increased becomes facilitated in dealing with the 
machining operation. 

[0043] FIG. 10 shows a sixth embodiment of the 
invention. According to the sixth embodiment, there is 
provided a tool unit which is easy to position and hold a 
pipe of a machining object relative to the tool unit (rela- 
tive to the robot wrist). According to the sixth embodi- 
ment, on an attaching portion 15a of a tool unit 15 for 
attachment to the robot wrist la. there is attached a 
tx>ss 15z in a shape of a frustum having a center axis in 
coincidence with the rotational center axis of the tool 
unit 15 (the final rotational axis 1 of the robot movable 
arm), and the boss 15z is brought to be opposed to a 
workpiece W of a pipe like shape. Further, the boss 15z 
is made rotatable to a main body of the tool unit 1 5. The 
robot is positioned such that the central axis of the pipe 
of the workpiece W coincides with the final rotational 
axis 1 of the movable arm of the robot (center axis of the 
robot wrist la, rotational center axis of the tool unit 15), 
the rok>ot wrist is moved parallel along the axis to 
thereby press to fit the t>oss 15z to the pipe W of the 
workpiece such that the central axis of the pipe W is not 
deviated from the rotational axis of the tool unit 15. Fur- 
ther, while rotating the final axis la of the movable arm 
of the robot and rotating the tool unit 15, the workpiece 
is cut or drilled by the machining nozzle 2. When the tool 
unit 15 is rotated, although the boss 15z is rotated rela- 
tive to the tool unit main body, the boss 15z Is not 
rotated relative to the pipe of the workpiece W arxJ 
accordingly, no hindrance is produced in rotating the 
tool unit main body 15, the pipe W is cut or a hole is 
formed such that the rotationed center axis of the tool 
unit 15 coincides with the rotational center axis of the 
pipe and therefore, high accurate machining operation 
can be carried out. 

[0044] Although according to the example of the 
embodiment shown in FIG. 10. an example of attaching 
the boss 15z to the second embodiment shown in FIG. 
3 has been shown, the boss 15z is applicable also to the 
tool units according to the first through the fifth embodi- 
ments mentioned atx>ve. 

[0045] Next, an explanation will be given on machining 
operation on a workpiece by a robot with the above 
mentioned tool unit. 

P)046] First, the nonvolatiie memory portion of the 
memory 102 of the robot controller is previously stored 
with kinds of workpieces and calculation equations of 
paths of distal ends of tool units in respect of machining 
shapes. For example, when as an example, the work- 
piece W is a pipe in a circular pipe shape and saddle 
shape cutting is carried out in order to bring the work- 
piece W into abutment connection with the other pipe P 
as shown In FIG. 1 1 . a calculation equation of a path of 
a distal end of a tool unit is calculated as follows. 
[0O47] FIG. 16 and FIG. 17 are explanatory views 
showing a way of obtaining a calculation equation in 
respect of a path of a distal end of a tool unit when the 
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workpiece W is cut in a saddle shape for connecting the 
workpiece (pipe) W to the pipe P. As shown in FIG. 16 
and FIG. 1 7, the center axis of the pipe P (counterpart 
of abutting) is set to X-axis, the center axis of the work- 
piece W is set to Y-axis and an axis perpendicular to the 
X-axis and Y-axis is set to Z-axis. Further, the origin 
point of the perpendicular coordinates system is set to 
an uppernrjost position where the pipe P and the work- 
piece W are brought into contact with each other and + 
direction of Y-axis is set to a direction departing from the 
cut face and + direction of Z-axis is set to a downward 
direction. 

[0048] As shown in FIG. 1 6, a radius of an outer diam- 
eter of the pipe P is designated by R. a radius of an 
outer diameter of the workpiece W is designated by 
notation r. a distance (distance in Y-axis direction) 
between the uppermost position (position of origin 
point) where the pipe P and the workpiece W are 
brought into contact with each other and the center axis 
of the pipe P is designated by notation A and a distance 
(distance in Z-axis direction) between a position of an 
uppermost end of the pipe P and the position of the ori- 
gin point is designated by notatk>n B. 
[0049] An arbitrary position in the cut face of the work- 
piece W Is defined by a position (y. z) of Y-axis and Z- 
axis and a rotational amount at the position from the 
uppermost position of the pipe P is defined as 6 as illus- 
trated by FIG. 16. Then, 

y = R sine - A 

z = R - B - RcosO = R(l-cose) - B 

accordingly, 

sine - (Y+A)/R 
cose « 1-{(z+B)/R} 

further, 

sin^e +cos^e = 1 

accordingly, 

[(y+A)/Rl%[V{(z+B)/R}]^«1- 
accordingiy, 

R'=(y+A)%{R-(2+B)}2 (1) 

further, as shown in FIG. 17, when in the workpiece W. 
a rotational angle of the arbitrary point (y. z) from the ori- 
gin point is designated by notation a, the following 
Equation (2) is established. 

zsr-rcosa = r(1-cosa) (2) 
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[0050] By substituting Equation (1) for Equation (2) to 
thereby calculate a relationship between the rotational 
angle a and the value y of Y-axis as follows. 

^ y = [R^-[R-{r(1-cosa)+B}] ^] - A 

= ± [[2R-{r(1-cosa)+B}][r(1-cosa)+B]] - A 

Accordingly, 

10 

y = |[[2R-{r(1 -cosa)+B}][r(1 -cosa)+Bll -A| (3) 

[0051] In the above-described Equation (3). the rota- 
tional angle a is a rotational angle of the tool unit and 

75 signifies the rotational angle of the final axis la of the 
movable arm of the robot and the rotational speed is 
controlled to a set predetermined speed. Further, the 
value y of Y-axis signifies a position of moving the tool 
unit in the axial direction of the workpiece W and signi- 

20 fies a movement amount of the second variable axis 
according to each of the second embodiment and the 
third embodiment (axis moving in parallel with the 
center axis of the final axis la of the movable arm of the 
robot) and Equation (3) shows the calculation equation 

25 of the path of the distal end of the tool unit in accord- 
ance with rotation of the tool unit (rotation of the final 
axis 1 a of the moval3le arm of the robot). 
[0052] Further, in order to determine the calculation 
equation of the path of the distal end of the tool unit by 

30 Equation (3), the radius R of the pipe, the radius r of the 
workpiece. the distance A between the uppermost posi- 
tion where the workpiece W is brought into contact with 
the pipe P and the central axis of the pipe P and the dis- 
tance B between the uppermost position of the pipe P 

35 and the uppermost position of the workpiece W, may be 
known. Hence, these data of R, r, A. B are set as por- 
tions of parameters in the saddle shape machining. 
[0053] When the workpiece W is alxjtted and con- 
nected to the pipe P such that the central axis of tiie 

40 pipe P and the central axis of the workpiece W intersect 
with each other (when abutting is carried out such that 
the center line of the workpiece W is disposed on a cen- 
tral point of the pipe P). B = R-r . A = (R^-r^) and 
accordingly, In this case. Equation (3) k>ecomes Equa- 
ls tion (4) as follows. 

y = |[(R+rcosa)(R-cosa)] ''^-(R2-r2) (4) 

[0054] In this case the radii R and r may be set without 
so setting the parameters A and B and the calculation 
equation of the path of the distal end of the tool unit may 
be used by using Equation (4). 
[0055] Further, the nonvolatile menfx>ry portion of tiie 
memory 102 is stored with data giving workpiece num- 
ss bers to a plurality of workplaces which are scheduled to 
machine and specifying kirxis of workpleces W (a pipe 
having a circular section, a pipe having an elliptic sec- 
tion, a pipe having a square section etc.) and their 
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shapes for respective work numbers and calculation 
equations of the paths of the distal ends of the tool units 
mentioned above are calculated in accordance with the 
workpiece numbers and machined shapes (plane cut- 
ting, saddle shape machining, forming a hole etc.) and 
are stored to the nonvolatile memory portion of the 
memory 102 of the robot controller. Further, the nonvol- 
atile memory portion of the memory 102 is stored with 
machined shapes capable (not capable) of machining 
workpieces in respect of numbers in correspondence 
with kinds of workpieces W. names of modes of machin- 
ing such as cutting, saddle shape machining, forming a 
hole and the like as well as the workpiece numbers 
(kinds of workpieces). 

[0056] In teaching operatk>n for machining, when a 
command for teaching operation is inputted from the 
teaching operation panel 104 to the robot controller. 
CPU 1 01 of the robot controller starts teaching process- 
ing shown in FIG. 14. 

[0057] First, kinds of workpieces and numbers in cor- 
respondence thereto are displayed on a display screen 
of the teaching operation panel 104 and an operator 
inputs a number in accordance therewith to thereby 
select a kind of a workpiece (Step SI), then. CPU 101 
displays kinds of shapes and urges selection (Step S2). 
When the operator selects a machining shape, the 
operation determines whether the selected shape can 
be machined in respect of shapes of workpieces in cor- 
respondence with the inputted workpiece number 
t>ased on a set storage content (Step S3) and when the 
machining cannot be carried out, an alarm is outputted 
(Step S7) and the operation urges again selection of 
machining shape. 

[0058] Further, when the selected machining shape is 
proper, the operation displays names of parameters 
necessary for machining the machining shape and 
awaits for input of respective parameters (Step S4). In 
the case of saddle shape cutting mentioned above, the 
radius R of a cylindrical body of a pipe on the side of the 
counterpart which is to be abutted with a cut workpiece 
W. the radius r of the workpiece to be cut. the parame- 
ters A and B and a wall thickness of the workpiece W for 
determining output of laser, are set and inputted. When 
all of the parameters and the wail thickness of the work- 
piece W concerning the selected machining she^^e are 
set and a setting finish signal is inputted, CPU 101 
stores the inputted workpiece number, the machining 
shape and the parameters at the nonvolatile memory 
portion of the memory 102 as machining data and 
teaching of machining operation is finished. 
[0059] When machining is actually can-ied out, by a 
teaching program, after positioning a tool unit attached 
to a robot wrist to a workpiece. that is, after the center 
axis of the workpiece W and the rotational center axis of 
the final axis of the movable arm of the robot coincide 
with each other and the machining nozzle 2 of the tool 
unit is positioned at a machining start position of the 
workpiece W, when a workpiece number an6 a machin- 
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ing command are read from the teaching program. CPU 
starts machining processing of FIG. 15. 
[0060] Rrst the CPU reads the machining data 
(machining shape and parameters) in correspondence 

5 with the read workpiece number from the nonvolatile 
memory section of the memory 102 arxJ stores in the 
RAM (Step T1), selects a cak^ulation equation of a path 
of a distal end of the tool unit from the workpiece 
number and the selected machining shape, carries out 

10 planning of the path based on a motion command by 
using values of set parameters and calculates the path 
and speed of the distal end of the tool unit. Further, out- 
put power of laser is calculated from the wall thickness 
of the set workpiece W and is outputted to the laser 

IS oscillator 1 08 (Step T2). 

[0061 ] Next, it is determined whether or not the calcu- 
lated path falls in an operational range of the robot, and 
when the path is out of the range an alarm is outputted 
(Step T6) and the machining processings are finished. 

20 When the path is within the range, the CPU calculates 
movement amounts of respective axes at each interpo- 
lation period based on the path and the speed calcu- 
lated by the path scheme at Step T2 and outputs them 
to thereby drive servo nfx>tors of respective axes (Step 

25 T4). That is. in the case of saddle shape cutting men- 
tioned above, the final axis la of the movat^le arm of the 
robot is rotated at the set predetermined speed and 
motion command amounts for respective interpolation 
periods are calculated and outputted to the addltkDnal 

30 variable axis (the secorxi additional variatile axis 1 1c In 
the second embodiment, the second additional variable 
axis 12e in the third embodiment) which is moved in 
parallel with the rotatk>nal center axis of the final axis 
la. Further, it is determined whether or not the move- 

35 ment reaches a desired position (Step T5) and the inter- 
polation processing is carried out until the movement 
reaches the desired position, and when the movement 
reaches the desired position, the machining processing 
is terminated. 

40 [0062] According to the present invention, a work- 
piece of a pipe shape can be cut only by rotating a final 
axis of a movable arm of a robot and without driving 
other movable arm of the robot. Accordingly, machining 
operation having high machining accuracy can be car- 

45 ried out. Further, by providing a linear nfx>vement axis or 
a rotary or pivoting axis at a tool unit, the machining for 
forming a hole or the saddle shape cutting on a work- 
piece of a pipe shape an be performed. Further, it is 
possible to machine a pipe shaped workpiece to have a 

50 slant cut face with respect to an outer surface thereof. 

Claims 



1 . A robot system comprising: 

55 

a movable arm including a plurality of linte con- 
nected by joints and controlled by a robot con- 
troller having a software processing function; 



8 



NSDOCID: <EP ^094181 5A2J_> 



15 



EP0 941 815 A2 



16 



and 

a tool unit mounted on a distal end of said mov- 
able arm, and having an effecting end biased 
with respect to a final rotational axis of said 
movable arm and directed to said final rota- s 
tional axis. 

A robot system according to claim 2, wherein said 
movable arm includes a wrist and said final rota- 
tional axis is provided at said wrist. io 

A rotx)t system comprising: 

a movable arm including a plurality of links con- 
nected by joints and controlled by a robot con- is 
troller having a software processing function; 
and 

a tool unit mounted on a distal end of said mov- 
able arm and having an effecting end and a 
variat^e axis for varying a position or a direction 20 
of said effecting end with respect to a final rota- 
tional axis of said movable arm. 

A robot system according to claim 3, wherein said 
variable axis includes a linear axis. 2s 

A robot system according to claim 4, wherein said 
linear axis allows said effecting end to move per- 
pendicularly or parallel to said final rotational axis. 

30 

A robot system according to claim 3, wherein said 
variable axis includes a rotary axis. 

A robot system according to claim 3. wherein a lin- 
ear axis and a rotary axis are provided, each func- 35 
tioning as said variable axis. 

A robot system comprising: 

a movable arm including a plurality of links con- 40 
nected by joints and controlled by a robot con- 
troller having a software processing function; 
and 

a tool unit mounted on a distal end of said mov- 
at)le arm, and having an additional rotation axis 4S 
biased with respect to a final rotational axis of 
said movable arm and an effecting end biased 
with respect to said additional rotation axis and 
directed to said additional rotation axis. 

50 

A method of machining a cylindrical workpiece with 
a robot system comprising a nxivabte arm including 
a plurality of links connected by joints and control- 
led by a robot controller having a software process- 
ing function, a tool unit mounted on a distal end of 65 
said movable arm. and having an effecting end 
biased with respect to a final rotational axis of said 
movable arm and directed to said final rotational 



axis, said method comprising the steps of: 

(a) arranging the workpiece so that a central 
axis of the workpiece is aligned with the final 
rotational axis of said movable arm; and 

(b) rotating said final rotary axis to perform 
machining on the workpiece. 

10. A method according to claim 9. wherein said mova- 
ble arm includes a wrist and said final rotational 
axis is provided at said wrist. 

1 1. A method of machining a pipe-like workpiece with a 
robot system comprising a movable arm including a 
plurality of links connected by Joints and controlled 
by a robot controller liaving a software processing 
function, and a tool unit mounted on a distal end of 
said movable arm and having an effecting end and 
a variable axis for varying a positron or a direction of 
said effecting end with respect to a final rotational 
axis of sakj movable arm, said method comprising 
the steps of: 

(a) arranging the workpiece so that a central 
axis of the workpiece is aligned with the final 
rotational axis of said nrK)vat)le arm; and 

(b) rotating said final rotary axis to perform 
machining on the workpiece. 

12. A method of machining a cylindrical workpiece 
according to claim 11, wherein sakJ variable axis 
includes a linear eucis. 

13. A method of machining a cylindrical worl^iece 
according to claim 12, wherein said linear axis 
allows said effecting end to move perpendicularly 
or parallel to saki final rotational axis. 

14. A method of nnachining a cylindrical workpiece 
according to claim 1 1 . wherein said variable axis 
includes a rotary axis. 

15. A method of machining a cylindrk;ai workpiece 
according to claim 11, wherein a linear axis and a 
rotary axis are provided, each functioning as said 
variable axis. 

1 6. A method of machining a pipe-like workpiece with a 
robot system comprising a nx>vable arm including a 
plurality of links connected by joints and controlled 
by a rofcK)t controller having a software processing 
function, and a tool unit mounted on a distal end of 
sakJ movable arm and having an effecting end and 
a variaksle linear sods for varying a position of saKl 
effecting end with respect to a final rotational axis of 
said movable amn, sakJ method comprising the 
steps of: 
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(a) arranging the workpiece so that a central 
axis off the workpiece is aligned with the final 
rotational axis of said movable arm; and 

(b) rotating said final rotational axis and driving 
said variable linear axis in synchronism with s 
the rotation of said final rotational axis to per- 
form a saddle-like cutting or forming a hole on 
the workpiece. 
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axis, a cutting tool (machining nozzle of laser) at a distal 
end of the tool unit is turned about the final axis to cut a 
workpiece W of a pipe shape. By driving the first and the 
second additional variable axes in synchronism with 
rotatksn of the final axis, the cutting into a saddle shape 
and the forming of a hole are carried out. The movable 
arm of the robot is only for rotating the final axis and 
therefore machining accuracy is promoted. 
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